Interfacing the HPC and 
LM629 for Motion Control 



INTRODUCTION 

Control of servo motors has a wide range of applications 
including industrial control, factory automation, position and 
velocity servomechanism, and robotics. The basic tasks in- 
volved in such motion controls include position, velocity, 
and acceleration measurement, implementation of PID algo- 
rithm, detection of overrun and stress conditions, and com- 
munication back to a central controller. The HPC high per- 
formance microcontroller in conjunction with LM629 motion 
controller chip provides a solution for handling these re- 
quired control tasks with extremely high degree of precision 
and very little software overhead. 

The HPC is a highly integrated and high performance mem- 
ber of the HPCtm family of National's microcontroller. The 
availability of a wide variety of on-chip peripherals such as 
high speed timers, high speed l/Os, input capture, A/D, 
PWM, UART and MICROWIREtm provides a flexible archi- 
tecture for a wide variety of high performance applications 
at a reasonable cost. The LM629 is a National's dedicated 
motion-control processor designed for use with a variety of 
D.C and brushless D.C servomotors which provide a quad- 
rature incremental position feedback signal for close-loop 
operation. The LM629 stand alone can perform all the inten- 
sive, real-time computational tasks required for high per- 
formance digital motion control. As a result in a multi-task 
system using the HPC where one of the tasks requires pre- 
cision servo control can be achieved with this chip-set with 
minimal software overhead and very little CPU time. 
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THE INTERFACE DESIGN 

Figure 1 shows the interface between the HPC and the 
LM629 via an 8-bit parallel bus. As shown in the figure, the 
HPC (host controller) interfaces with the LM629 data bus 
(D0-D7) on the lower half of PORTA (MUXed address/data 
bus). The HPC in this application, is used in 8-bit Expanded- 
Normal mode (strapping the HBE pin to Vcc, EXM pin to 
ground and EA bit in the PSW set to a one). The advantage 
of such a configuration is the upper half of the address/data 
bus (PORTA bits 8:15) will latch the address which is used 
to generate the required chip select for the LM629. This 
eliminates the requirement of an address latch for the de- 
coder logic. 

The delay and the logic associated with HPC write strobe 
(WR) is added to increase the write-data hold time (as 
viewed from the LM629 end) effectively causing the WR 
pulse to rise early. The LM629 clock is provided by the CK2 
output of the HPC. Since the LM629 has a maximum run- 
ning speed of 8 MHz, the fastest HPC could run in such 
applications will be 16 MHz. The 74HC245 is used to de- 
crease the read-data hold time), which is necessary when 
interfacing HPC with slower peripherals. 
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FIGURE 1. Interface between the HPC and LM629 



HPCtm and MICROWIREtm are trademarks of National Semiconductor Corporation. 
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The LM629 Host Interrupt (HI) output could be hardwired to 

an input capture port (12 in this case) or the NMI pin of the 

HPC for handshaking purposes. 

The Port Select (PS) input is hardwired to the pin B1 of the 

HPC for selecting command or data when communicating 

with the LM629. 

The LM629 gets its RESET from the HPC which is low for a 

minimum of 8 CK2 periods to satisfy its reset requirement. 

USER-SYSTEM INTERFACE 

Figure 2 shows a typical system implemented for handshak- 
ing between the user and the motion controller block. In this 
specific application, this is developed using the HPC's on- 
chip UART communicating at 4800 baud using a standard 
10 MHz HPC input clock (CKI). Any terminal {e.g., a VT100) 
hooked to the HPC UART via the MAX232 should serve the 
purpose. The user can then input data required to control 
the motor trajectory and tuning the PID filter for precision 
motion control via this interface. 
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FIGURE 2. User-System Interface 
PWM MOTOR DRIVE INTERFACE 

Figure 3 shows an LMD 18200 — a 3A H-bridge driver is in- 
terfaced to the LM629 PWM outputs to provide power am- 
plification for driving brush/commutator and brushless D.C. 
motors. The motor used in this application is a brush D.C. 
motor with a HP HEDS 5300 incremental optical shaft en- 
coder with 2-channel (without the index pulse) and 500 cps 
providing TTL compatible digital output. 
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FIGURE 3. DC Motor Output Driver Stage 
MOTION CONTROL SOFTWARE 

Appended at the end of this application note is a flowchart 
(Figure 4) for initiating a simple motor movement and a sam- 
ple software (in "C") provided for the benefit of the reader. 
Note that the requirements of individual routines are very 
much application specific and left for the user to develop as 
required. 

TUNING THE PID 

When connecting up a drive system for the first time, there 
could be a possibility that the loop phasing is incorrect. As 
this may cause severe oscillation, it is recommended to use 
a low value for the proportional gain, say Kp = 1 (with Kd, 
Ki, and il all set to zero), which will provide a weak level of 
drive to the motor. If the system does oscillate with this Kp 
value then the motor connections should be reversed. 
Having determined that the loop phasing is correct Kp can 
now be increased to about 20 to see that the control system 
basically works. This value of Kp should hold the motor 
shaft reasonably stiffly, returning the motor to the set posi- 
tion, which will be zero until trajectory values have been 
input and a position move performed. If oscillation and un- 
acceptable ringing still occurs, Kp should be reduced until it 
stops. Low values of acceleration and velocity can now be 
input, of around 100, and a position move commanded to 
say 1000 counts. All values suggested here are decimal. 
It is useful at this stage to try different values of acceleration 
and velocity to get a feel for the system limitation. These 
can be determined by reporting desired and actual velocity 
and acceleration to see that the error is not increasing with- 
out bound. 
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FIGURE 4. Flowchart of a Simple Motor Move 



CONCLUSION 

The combination chip-set HPC and LM629 (also the LM628) 
form the core of a powerful solution to position servo prob- 
lems. Commanded by the HPC microcontroller, the most 
powerful single-chip microcontroller available, this unique 
combination is the key to a flexible and easy-to-implement 
coordinated multi-axis motion system. 
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#include H hpcl6083.h" 

#include <stdio.h> 

#define lm629 (*(char *) (0x5000)) 

extern int atoi ( const char * ) ; 

extern char getchar( ) ; 



/************************************************** 

* LM629 COMMAND SET * 

* Use 8.00 MHz part; HPC running at 10.00 MHz * 

* Optical Shaft Encoder: HP HEDS5300 * 

* which has 500 cycles/rev (lines) & -20 to 85 * 

* degree celcius op. range * 
Vmax = 30,000 rpm & Accl(max) = 250,000 rad/s2 



************************************************** 



/ 



#define 
#define 
#define 
#def ine 
#def ine 
#define 
#define 
#define 
#def ine 
#define 
#def ine 
#def ine 
#define 
#define 
#def ine 
#def ine 
#def ine 
#define 
#define 
#define 
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/* 
/* 
/* 

/* 
/* 



/* 
/* 

/* 
/* 
/* 
/* 



/* 
/* 
/* 

/* 



reset lm629 */ 
reset interrupts */ 
define home */ 
set index position */ 
intrpt. on error */ 
/* stop on error */ 
/* set bkpt. absolute */ 
set bkpt. relative */ 
mask intrpts */ 
load filter parameters * 
update filter */ 
load trajectory */ 
start motion */ 
/* read signals reg */ 
/* read indx. position */ 
/* read desired position */ 
read real position */ 
read desired velocity */ 
read real velocity */ 
read integration sum */ 



/ 



char num [ 5 ] ; 

int getnum( void) ; 

void wr_data( unsigned char); 

void wr_cmd( unsigned char); 

unsigned int getnum( void) ; 

unsigned char rd_st(void); 

void chk_bsy ( void ) ; 

unsigned char rd_data( void) ; 

void traj_sel(void) ; 

void f ilter_sel( void) ; 

int cnt = 0; 

void run__motor( void ) ; 

BASEPAGE INDXPH, INDXPL, SIGREGH, SIGREGL; 



BASEPAGE volatile struct 

{ 
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unsigned 
unsigned 
unsigned 
unsigned 
unsigned 
unsigned 
unsigned 
unsigned 



bsy: 1; /* busy bit */ 

cmd_err: 1; /* command err (int) */ 

trj_cmp: 1; /* tra j . over (int) */ 

indxpls: 1; /* indx. pulse (int) */ 

wrp_occ: 1; /* wraparound (int) */ 

posn^err: 1; /* excess pos.err( int )*/ 

bkptrch: 1; /* bkpt. reached(int) */ 

motor off: 1; /* motor off */ 



} status; 



#define STATUS (*( volatile unsigned char *)&status) 



INTERRUPT2 HOST_INTR( void ) 

{ 

if(cnt == 0) 

goto done; 

printf( "\r\n\n" ); 

printf ( "*********** HOST INTERRUPT!! **************\ r \n" ) ; 

rd_st( ); 

print f( "STATUS : %x\r\n" , STATUS ) ; 

if ( status. bsy ) 
printf( "ERROR .. RD/WR WHILE LM629 IS BUSY I! \r\n" ); 

i f ( status . cmd_err ) 
printf ( "COMMAND ERROR ! ! \r\n" ) ; 

i f ( status . tr j_cmp ) 
printf ( "MOTOR TRAJECTORY COMPLETE ! \r\n" ) ; 

if ( status . indxpls ) 
printf ( "INDEX PULSE OCCURRED. \r\n" ) ; 

if ( status. wrp_occ) 
printf ( "POSITION RANGE ERROR !!\r\n" ); 

i f ( status . posn_err ) 
printf ( "EXCESSIVE POSITION ERROR !!\r\n" ); 

i f ( status . bkpt_rch ) 
printf ( "MOTOR REACHED SET BRKPT. POSITION. \r\n" ) ; 

if (status. motor_off ) 
printf ( "STALLED MOTOR CONDITION. \r\n" ) ; 

done: 
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cnt 



/* Variables */ 

unsigned char val,CMD,c; 

unsigned int NLINE,VEL_FIN, ACCL,FIN_P0S,CLK_SC; 

int SMP_RT,CLK,Kp; 

long VELVAL , ACCVAL , POS_VAL ; 

int ACCHI , ACCLO , POSHI , POSLO , VELHI , VELLO , SMP_TIME ; 

void main (void) 

{ 

unsigned int choice; 

/$ 

LD 0xc0.b,#010 



$/ 



set_uart ( ) ; 

IRPD = 0; 

IRCD = 0x04; /* rising edge on 12 for HI */ 

printf ( "\r\n\nRESETTING THE LM629 FOR TEST RUN. \r\n\n" ) ; 

ENIR - 5; 

rd_st(); /* Read status byte */ 

if (STATUS == 0xC4 | | STATUS == 0x84) 

{ 

printf ("H/W RESET SUCCESSFULLY COMPLETED\r\n" ) ; 
printf ( "STATUS BYTE : %x\r\n\n\n" , STATUS ) ; 

printf ( "EXECUTING RSTI NOW. . \r\n" ) ; 

chk_bsy( ) ; 

wr_cmd(RSTI) ; /* Command code = OxlD */ 

chk_bsy( ) ; 

wr_data(0x00); /* Reset byte of Int. control Reg */ 

wrdata(OxOO); /* Reset byte of Int. control Reg */ 

} 

else 
{ 
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printf ("*** H/W RESET FAILURE, TRY AGAIN ***\r\n"); 
printf ( "STATUS BYTE : %x\r\n\n" , STATUS ) ; 
while(l); 

} 
rd_st( ); 

if (STATUS == 0x80 \ j STATUS ==0xC0) 

{ 
printf ( "LM629 RESET SUCCESSFULLY COMPLETED. \r\n" ) ; 
printfC "STATUS BYTE (AFTER RSTI ) : %x\r\n\n\n" , STATUS ) ; 
menu: 

printf ( "\r\n\n\n\n" ) ; 

printf (" SELECT ONE FROM THE FOLLOWING NOW:\r\n" ); 

printf ( " \r\n" ); 

printf ( " 1 LOAD NEW FILTER DATA \r\n" ) ; 

printf ( " 2 LOAD NEW TRAJECTORY DATA \r\n" ) ; 

printf ( " 3 RUN THE MOTOR\r\n" ) ; 



printf ( "-->" )• 

choice - getnum(); 

switch( choice ) 
{ 

case 1 : 

f ilter_sel( ) ; 

break; 

case 2 : 
traj_sel( ) ; 
break; 

case 3 : 
run_motor( ) ; 
break; 

default: 

printf ("\r\nBAD SELECTION, TEST EXITED !!\r\n"); 

} 

goto menu ; 



} 



printf ( "RSTI COMMAND FAILED, RESET LM629 AGAIN\r\n" ) ; 
while(l); 
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/********************************** 

* Check the BUSY bit * 
*********************************/ 

void chkbsy(void) /* Check if lm629 bsy */ 

{ 
char ST; 
ST = rd_st( ); 

while(ST & 0x01); 

} 

/********************************** 

* Command WR to the LM629 * 
*********************************/ 

void wr_cmd( unsigned char CMD) 

{ 

portbl.bitl = 0; /* Pull /PS=low */ 

dirbl.bitl = 1; 

lm629 = CMD; /* write to LM629 */ 

dirbl.bitl = 0; 

printf( "COMMAND SENT TO LM629 : %x \r\n",CMD); 
} 

/ ******************************** 

* Data WR to the LM629 * 

* data written in byte pairs * 
********************************/ 

void wr_data( unsigned char val ) /* Most significant byte first 

*/ 

{ 

portbl.bitl = 1; /* Pull /PS=high */ 
dirbl.bitl = 1; 
lm629 = val; /* write to LM629 */ 

dirbl.bitl = 0; 
printf ( "DATA SENT TO LM629 : %x \r\n",val); 
} 

/******************************** 

* Data RD from the LM629 * 

* data read in byte pairs * 
********************************/ 

unsigned char rd_data( void) 

{ 

char tmp; 

portbl.bitl = 1; /* Pull PS high */ 
dirbl.bitl = 1; 
tmp = lm629; 
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dirbl.bitl = 0; 
return ( tmp) ; 
} 

* Reading Status Byte From LM629 * 

unsigned char rd_st(void) 
{ 

portbl.bitl =0; /* Pull /PS low */ 

dirbl.bitl = 1; 

STATUS=lm629; /* Dummy read to pull /RD and /CS low */ 

dirbl.bitl - 0; /* Deselect LM629 */ 

return ( STATUS ) ; 

/* Save it in status memory */ 
} 

unsigned int getnum(void) 

{ 

unsigned int i=0,NUM; 

char c; 

extern char num [ ] ; 

while (c=getchar( ) ) 

{ 

num[i++] = c; 
if( c == '\r' || c« '\n') { 
num[i] = '\0'; 

break; } 

} 

NUM = atoi(num); 
return (NUM); 
} 

void trajsel(void) 
{ 

printf ( "\r\n\n" ) ; 

printf( "ENTER ENCODER LINES : " ) ; 

NLINE = getnum( ) ; 

printf ( M \r\n" ); 
printf ( "ENTER FINAL VELOCITY (RPM) :"); 

VEL_FIN = getnum(); 

printf ("\r\n"); 
printf ( "ENTER FINAL POSITION (REVS) : "); 

FIN_P0S = getnum( ) ; 

printf ("\r\n"); 
printf ( "ENTER ACCELERATION (REVS/S-2) : " ) ; 

ACCL = getnum(); 

printf ("\r\n" ); 

P0S_VAL = NLINE * 4.0 * FIN_P0S; 

printf ("POSITION VALUE TO LOAD : %lx\r\n" , P0S_VAL) ; 
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VEL_VAL = NLINE * 4.0 * SMPTIME * 1.0E-6 * VEL_FIN * (1.0/60.0)* 
65536.0; 

printf ( "VELOCITY VALUE TO LOAD : %lx\r\n M , VEL_VAL) ; 

ACC_VAL = NLINE * 4.0 * SMPJTIME * SMP_TIME * 1.0E-12 * ACCL * 65536.0; 
printf ("ACCL. VALUE TO LOAD : %lx\r\n" , ACCVAL) ; 

ACCLO = (unsigned int)(ACC_VAL & OxOOOOffff); 

ACCHI = (unsigned int ) ( ( ACC_VAL >> 16) & OxOOOOffff); 

VELHI = (unsigned int) ((VELVAL >> 16) & OxOOOOffff); 
VELLO = (unsigned int) (VELVAL & OxOOOOffff); 

POSHI = (unsigned int) ( ( POS_VAL >> 16 )& OxOOOOffff); 
POSLO = (unsigned int) ( POSVAL & OxOOOOffff); 



printf ( "LOADING NEW TRAJECTORY DATA\r\n"); 

chk_bsy( ) ; 

wr_cmd(LTRJ); 

chk_bsy( ) ; 

wr_data(0x00); 
wr_data(0x2A); 
chk_bsy( ) ; 

wr_data( (ACCHI >> 8) & OxOOff); 
wr_data( ACCHI & OxOOff); 
chk_bsy( ) ; 

wr_data( (ACCLO >> 8) & OxOOff); 

wr_data( ACCLO & OxOOff); 
chk_bsy( ) ; 

wr_data( (VELHI >> 8) & OxOOff); 

wr_data( VELHI & OxOOff); 
chk_bsy( ) ; 

wr_data( (VELLO >> 8) & OxOOff); 

wr_data( VELLO & OxOOff); 
chk_bsy( ) ; 

wr_data( (POSHI >> 8) & OxOOff); 

wr_data( POSHI & OxOOff); 
chk_bsy( ) ; 

wr_data( (POSLO >> 8) & OxOOff); 

wr_data( POSLO & OxOOff); 

printf ( "TRAJECTORY DATA LOAD COMPLETED. \r\n\n\n" ) ; 
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void filter_sel( void) 
{ 

print f("\r\n\n"); 

printf ("SELECT CLOCK RATE (2-8 MHz) : " ) ; 

CLK = getnum( ) ; 
printf ( "\r\nCLOCK RATE IS : %d MHz\r\n" , CLK) ; 

printf ( "SELECT CLOCK SCALAR (0-255 DEC) : " ) ; 

CLK_SC = getnum( ) ; 
printf ("\r\nSCALAR TO LOAD: %x\r\n" , CLK_SC ) ; 

SMP_RT = 2048/CLK; 
SMP_TIME = (CLK_SC+1) * SMP_RT; 
printf ("SAMPLE TIME : %d usecs\r\n\n" , SMPJTIME ) ; 

printf ( "SELECT Kp TO LOAD : "); 

Kp = getnum( ) ; 
printf ( "\r\n" ); 



printf ( "LOADING NEW FILTER DATA\r\n" ) ; 

chk_bsy( ) ; 

wrcmd(LFIL); /* Load filter parameter cmd = Oxle */ 

chk_bsy( ) ; 

wr_data(SMP_RT); /* Bits 8-15 (MSB) set the derivative */ 
wr_data(0x08); /* sampling rate. = 256 uS */ 

chk_bsy( ) ; 

wr_data(0x00); 
wrdata(Kp) ; 

printf ( "FILTER DATA L0ADED\r\n" ) ; 

printf ( "UPDATING FILTER DATA NOW (UDF )\r\n" ) ; 

chk_bsy( ) ; 

wr_cmd(UDF); /* Update filter */ 

printf ( "UPDATED FILTER PARAMETERS (UDF) \r\n\n\n" ) ; 



} 



void run_motor ( void ) 

{ 

printf ( "EXECUTING STT TO RUN THE MOTOR . . ! ! \r\n" ) ; 
printf ( "WATCH THE MOTOR NOW .. ! ! \r\n\n\n" ) ; 



chk_bsy( ) ; 

wr cmd (STT); /* start motion 0x01 */ 



} 
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LIFE SUPPORT POLICY 

NATIONAL'S PRODUCTS ARE NOT AUTHORIZED FOR USE AS CRITICAL COMPONENTS IN LIFE SUPPORT 
DEVICES OR SYSTEMS WITHOUT THE EXPRESS WRITTEN APPROVAL OF THE PRESIDENT OF NATIONAL 
SEMICONDUCTOR CORPORATION. As used herein: 



1. Life support devices or systems are devices or 2. A critical component is any component of a life 



systems which, (a) are intended for surgical implant 
into the body, or (b) support or sustain life, and whose 
failure to perform, when properly used in accordance 
with instructions for use provided in the labeling, can 
be reasonably expected to result in a significant injury 
to the user. 



support device or system whose failure to perform can 
be reasonably expected to cause the failure of the life 
support device or system, or to affect its safety or 
effectiveness. 



00 
CO 



t? 



National Semiconductor 
Corporation 

2900 Semiconductor Drive 
P.O. Box 58090 
Santa Clara, CA 95052-8090 
Tel: 1(800)272-9959 
TWX: (910) 339-9240 



National Semiconductor 
GmbH 

Livry-Gargan-Str. 10 

D-82256 Furstenfeldbruck 

Germany 

Tel: (81-41) 35-0 

Telex: 527649 

Fax: (81-41) 35-1 



National Semiconductor 
Japan Ltd. 

Sumitomo Chemical 

Engineering Center 

Bldg. 7F 

1-7-1, Nakase, Mihama-Ku Hong Kong 

Chiba-City, Tel: (852) 2737-1600 

Ciba Prefecture 261 Fax: (852) 2736-9960 

Tel: (043) 299-2300 

Fax: (043) 299-2500 



National Semiconductor 
Hong Kong Ltd. 

13th Floor, Straight Block, 
Ocean Centre, 5 Canton Rd. 
Tsimshatsui, Kowloon 



National Semiconductores 
Do Brazil Ltda. 

Rue Deputado Lacorda Franco 

120-3A 

Sao Paulo-SP 

Brazil 05418-000 

Tel: (55-11)212-5066 

Telex: 391-1131931 NSBR BR 

Fax: (55-11) 212-1181 



National Semiconductor 
(Australia) Pty, Ltd. 

Building 16 
Business Park Drive 
Monash Business Park 
Nottinghill, Melbourne 
Victoria 3168 Australia 
Tel: (3) 558-9999 
Fax: (3) 558-9998 



National does not assume any responsibility for use of any circuitry described, no circuit patent licenses are implied and National reserves the right at any time without notice to change said circuitry and specificatioi 



